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(57) Abstract: The inventiye method consists in supplying motion instructions' (300) at least including information about the path 
^ geometry (320) and load instructions (3 10) \o a path generator (400), calculating an allied load signal (800), transmitting said applied 
^ load signal (800) to^the path generator (400), calculating motion instructions (500) along the path in such a way that the deviation 
^ between the projection of Uie applied load on a tangent to said path and the projection of the instruction on said tangent is minimised 

Oand in transmitting said motion instructions (500) to means for acmating a robot (600). A device comprising means (200, 400, 700) 
for carrying out said conuol is also disclosed. 
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vement (300) incluant au moins des informations relatives h la geometric de la trajectoire (320) et k des consignes d*effort (3 10); - 
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PROCEDE ET DISPOSTIIF DE COMMAJSTDE DES DEPLACEMENTS D'UNE 

PARTIE MOBILE D'UN ROBOT MULTI-AXES 

L' invention a trait a un procede et a un dispositif de 
commande des deplacements d'une partie mobile d'lin robot 
multi-axes le long d'une trajectoire. 

Dans le domaine de la commande des robots multi-axes, il 
est connu de commander un robot multi-axes grace a des 
boucles d' asservissement de type PID (proportioimelle 
integi-ale derivee) en position, vitesse et courant, afin de 
faix-e evoluer la partie terminale d'un robot, qui peut porter 
un outil ou un prehenseur, sur une trajectoire de geometrie 
et de profil de vitesse determines. II est egalement connu de 
commander un tel robot en diminuant la raideur 
d' asservissement sur chaque axe, afin de permettre une 
variation de la position du bras en lonction des efforts 
d' interaction entre les parties mobiles du robot et leur 
envi r onnement . Il est en particulier connu, par exemple de 
US-A-5, 742, 138, . de parametrer la raideur d'un bras de robot 
multi-axes dans un systeme de coordonnes rectangulaires , de 
mesurer une erreur de position, de calculer un effort et de 
corriger la position de la partie mobile du robot afin 
d'obtenir une certaine souplesse de I'organe terminal- Une 
telle souplesse peut etre utilisee pour realiser des 
operations de manipulation de pieces telle gu'un polissage, 
un ebavurage ou le dechargement d'une presse pour lesquels un 
effort de contact peut contrarier le mouvement programme du 
robot . 

Il est egalement connu de donner un effort de consigne 
dans xxn systeme. de • coordonnees rectangulaires afin de 
realiser une . c^eration a effort controle le long d'une 
trajectoire, par exemple pour une operation d' ebavurage ou de 

« 

polissage. 
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Dans les systemes coimus, on prevoit parfois que 
1' interface de programmation de trajectoire permette de 
specifier des paratnetres tels que -la vitesse ou 
1' acceleration de la partie mobile sur sa trajectoire, ces 
5 parametres determinant la position de la partie terminale du 
bras du robot le long de sa traj ectoire en f onction du temps . 

II est egalement connu de US~A-4 , 874 , 997 de controler de 
fagon numerique un moteur brustiless d' articulation de robot 
. par modulation de largeur d' impulsions. 

10 Dans ces systemes connus, il n'est pas possible de 

programmer de fa<?on aisee un robot mult i -axes pour que la 
trajectoire de deplacement de sa partie terminale puisse etre 
controlee en vitesse et acceleration d'une part, et en effort 
tangent iel a la trajectoire du point de contact de sa partie 

15 mobile avec son environnement d' autre part, tout en 
respectant des valeurs de vitesse et d' acceleration 
compatibles avec la stmcture mecanique du robot. 

II est egalement connu de EP-A-0 349 2 91 de faire devier 
un robot de la trajectoire qu' il a apprise pour respecter une 

20 consigne d' effort en fonction de la geometrie reelle d'une 
piece a traiter. Dans ce cas, le controle de 1' effort est 
privilegie par rapport au suivi de- la trajectoire/ ce qui 
n'est pas compatible avec certaines ' utilisations dans 
lesquelles la trajectoire doit etre rigoureusement suivie. 

25 C'est a ces inconvenients qu'entend plus 

particulierement remedier 1' invention en proposant un precede 
dans lequel les interactions avec 1 ' environnement de la 
partie mobile d'un robot, notamment une piece ou Tin outil 
porte par' celui-ci, sont controlees avec precision. 

3 0 Dans cet esprit, 1' invention conceme un procede de 

coramande . des deplacements d'une partie mobile d'un robot 
multi-axes le long d'une trajectoire dans lequel sont. des 
prevues des etapes consistant a : 
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foumir a un genei-ateiir de trajectoire des 
instructions de mouvements incluant au moins des inf onnations 
x-elatives a 'la geometrie de la trajectoire et a des consignes 
d' effort / 

5 - calculer un signal dit d' effort exterieur representant 

au moins une composante de 1' effort exerce par la partie 
mobile sur son environfiement ; 

fournir, a une frequence d' echantillonnage 
predetearminee, le signal d' effort exterieur au generateur de 

10 trajectoire ; 

- calculer, au moyen du generateur de trajectoii^e et a 
une frequence d' echantillonnage predeterminee, des consignes 
de mouvement le long de la trajectoire de fa?on a minimiser 
I'ecart entre la projection de 1' effort exterieur sur la 

15 tangente a la trajectoire et la projection de la consigne sur 

cette tangente ; et 

fouomir les consignes de mouvement a un moyen 

d' asservissement qui permet de mettre en mouvement au moins 

un axe du robot conformement a ces consignes. 
20 L' asservissement en effort tangentiel peormet done de 

conserver la geometrie de la trajectoire, tout en adaptant la 

Vitesse de la partie mobile sur cette trajectoire. 

Selon des aspects avantageux, un precede de commande des 

deplacements d'une partie mobile d'un robot rtiulti-axes peut 
25 incorporer une ou plusieurs des daracteristiques suivantes : 

- Le signal d' effort exterieur est calcule a partir 
d'une information representant • le courant circulant dans au 
moins un actionneur du robot . 

- 11 est prevu une etape consistant a utiliser un modele ' 

30 dynaraique du robot lors du calcul ' du signal d' efforts 

. .* * . 

exterieur. 

II est pr§vu line etape consistant a. foumir au 
generateur de trajectoire* au moins une valeur limite de 
Vitesse et/ou une valeur limite d' acceleration pour prise' en 
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compte lors du calcul des consignes de mouvement, de telle 
sorte que • ces consignes soient conf oormes a cette ou ces 

valeurs limites. 

L' invention conceme egalement un dispositif permettant 
de mettre en csuvre un procede decrit ci-dessus et, plus 
specif iquement; un dispositif qui comprend : 

- un generateur de trajectoire apte a calculer des 
consignes de mouvements en fonction -d' instruction de 
niouvements incluant au moins des informations relatives a la 
geometrie de la trajectoire et a des consignes d' efforts et 

- un estimateur d' effort apte a generer un signal 
d' effort exterieur representant au moins une composante de 
1' effort exercee par la partie mobile sur son environnement 
et a fournir ce signal au generateur" de trajectoire, a une 
frequence d' echantillonnage predeterminee, alox'S que le 
generateur de trajectoire est apte a calculer les consignes 
de mouvements le long de la trajectoire, a une frequence 
d' echantillonnage .predeterminee, de fac?on §l minimiser I'ecart 
entre la projection de 1' effort exterieur sur la tangente et 
la trajectoire et la projection de la cponsigne d' effort sur 
cette tangente, ces consignes de mouvement etant fourni.es a 
un moyen d' asservissement permettant de mettre en mouvement 
.au moins un axe du robot. 

De fagon avantageuse, ce dispositif comprend un moyen 
interpreteur de programmes apte k executer des programmes qui 
comportent des instiructions de mouvements permettant de 
specifier au moins la geometrie de la trajectoire et des 

consignes d' efforts. 

Ij' invention sera mieux comprise et d'autres avantages de 
celle-ci apparaitront plus clairement a la lumiere de la 
description qui va suivre d'un' mode de realisation d'un 
procede conforme son principe, donne unicjuement a titre 
d'exemple et fait en reference aux dessins annexes dans 

* 

lesquels : 
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- La figure 1 est \me representation schexnatique de 
principe d'un robot multi-soces en train de deplacer une 
fi'aise' le long d'une trajectoire, grace a un procede conforme 
a 1 ' invention . 

- La figure 2 est une representation sctiemat iq[ue de 
principe de la repartition des efforts au niveau d'une partie 
mobile du robot de la figure 1. 

La figure 3 est un schema -bloc de principe 
representant le f ohctionnement general de 1' invention ; 

La figure 4 est un scbema-bloc de principe 
representant le transfert des consignes de position au 
systeme d' asservissement correspondant pour chaque moteur ; 

La figure 5 est un schema-bloc de principe 
representant 1 ' asservissement de chague moteur ; 

- La figure 6 est une representation de la methode 
utilisee pour estimer les efforts exterieurs et 

- La figure 7 represente I'algorithme utilise par 
le generateur de trajectoire poior generer les consignes de 
mouvements . 

Le robot R represente a la . figure 1 est un robot multi- 
axes a six articulations. II peut evoluer avec six degres de 
liberte. Le robot R peut etre commande . en mode cartesien, 
auquel cas ses degres de liberte peuvent etre trois degres de 
liberte en translation seloh la direction de trois axes X, Y 
et Z et trois degres de liberte en rotation Rx/ Ry/ et Rz 
autour des axes precites.. Le robot R peut egalement etre 
commande en mode articulaire, auquel cas ses degres de 
liberte peuvent etre six rotations Ri, R^, R3/ ^4/ Rs et Re 
autour de ses six axes d' articulation Xi/ X2/ X3, X4, X5 et Xs- 

. Ce robot est associe a* une unite de commande U qui 
controle son f onctionnement pendant les phases, 
d' apprentissage et d' utilisation. 

Un boltier B de commande - manuelle peut egalement §tre 
utilise pendant les phases d' apprentissage . 
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Dans I'exemple represents, le robot R porte un outil O, . ( 

tel qu'une f raise, qu'il convient de deplacer selon lane 

trajectoire T. * 

Comme il ressort plus particulierement de la figiire 2, 
5 on considers que 1' outil O est deplac§ par le robot .R le long 
du bord Bx d'une piece a f raiser. La trajectoire T est 
globalement parallele a ce bord. On note F 1' effort exerce 
par 1' outil O sux le bord Bi . On note Ft la composante de cet 
. effort tangente a la trajectoire T et Fn la composante de cet 
10 effort normale a la trajectoire T. 

Conformement a 1' invention, on utilise la valeur de la 
composante Ft dans le precede de commande des deplacements de 
1' outil O. 

Dans le descriptif suivant F est utilise au sens large 
15 et represente le vecteur des couples articulaires du bras 
robot ou le torseur des effort exterieurs integrant les 
efforts cartesiens Fx,Fy,Fz, et les couples cartesiens - 
Mx,My,Mz. 

Comme represent^ a la figure 3 1 ' environnement de 
programmation 100 permet a 1 ' utilisateur du syst^me de 
programmer le robot de maniere a ce qu'il realise les 
operations souhaitees. Ces operations sont decrites par des 
programmes. L 'environnement de programmation permet 
d'apprendre les positions successives que doit atteindre le 
robot, d'ecrire les programmes decrivant 1 ' enchainement des 
mouvements, de mettre au point ces programmes, de demarrer 
leur execution, de les arreter, etc.- 

Pour executer .. les programmes, 1 ' environnement de 
programmatibn fait appel a un interpreteur de prograi^es 200. 
30 Celui-ci execute les programmes destines a realiser une tache 
par le robot. Les programmes ex^cutis contiennent, entre 
autre, des instructions 300, dites instructions de mouvement . 
Elles d^crivent les types de mouvements que doit faire le 
robot (ligne droite, cercle,... etc), ainsi que les different 
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parametres les caracterisant (point d'arriv^e, vitesse , 
effort , ...) - 

Ces instructions de mouvement 300 sont transferees au 
generateur de- trajectoire 400. Celui est charge de leur 
execution, c'est-a-dire qu'il .doit generer regulierement 
(typiquement toutes les 4 inillisecondes) , en fonction de leur 
type et de leurs parametres, des consignes de mouvement 500. 
Ces consignes de mouvement 500 representent la trajectoire 
que doit suivre le robot, a chaque instant. Le robot 
industriel asservi 60 0 comprend un bras industriel a six axes 
ainsi que son syst^me d' asservissement . Le systeme 
d' asservissement est con<?u de mani^re a piloter les six 
moteurs du robot (un pour chaque axe) , de sorte que la 
trajectoire reelle du robot suive au mievix la trajectoire 
definie par les consignes de mouvement 500. 

Dans certaines applications, I'organe terminal du robot 
industriel 600 interagit mScaniguement avec son 
environnement : par exemple, la piece qu'il est en train de 
fraiser. L'estimateur d' effort exterieur 700 est un moyen 
d'obtenir un signal, dit effort exterieur 800, reprgsentant 
la valeur et la direction des efforts exerces par le robot 
sur son environnement. Ce signal est renvoye au generateur de 
trajectoire 400 en temps reel (typiquement toutes les 4 
millisecondes) . Ce dernier utilise ce retour d' information 
pour modifier les consignes de mouvement, de maniere a 
reguler les efforts d' interactions . 

L' environnement de prograramation comporte uxi boltier de 
coramande qui permet de deplacer le robot dans un mode 
interactif, de maniere a pouvoir apprendre les differentes 
positions que devra prendre ie robot. Il sert aussi 
d' interface de programmation pour editer et mettre au point 
les programmes . Le langage utilise pour 1 ' gcriture de ces 
programmes est un lailgage textuel,' mais d'autres types de 



wo 2005/062143 PCT/FR2004/003291 

8 

langages (graphiqiae par exemple) pourraient etre utilises 
dans le cadre de cette invention. 

Le langage 'utilise contient des instructions courantes 
dans les langages de progr animation de robot, qui permettent 
5 de specifier differents types de tnouvement , de controler leur 

a 

Vitesse et acceleration ainsi que leur enchainements . 

On presente maintenant, a titre d' exemple, ici deux 
autres instructions relatives a 1' invention. 
L ' instruction : 

10 MOVEiJF (position, outil^ params, force) 

specif ie que le robot doit deplacer I'outil qu'il porte 
definie par le parametre « outil », depuis la position finale 
du mouvement precedent jusqu'a la position definie par le 
parametre « position ». Le deplacement se fait en mode 

15 ar*ticulaire, c'est a dire qu'il y a un rapport de 
proportionnalite constant entr*e les deplacement s de chaque 
axe durant le mouvement- Le parametre « params » specif ie les 
vitesses et accelerations a ne pas depasser durant le 
mouvement. II specif ie aussi si le mouvement doit etre 

2 0 enchaine au mouvement suivant . Enfin, le parametre « force » 
specif ie la valeur desiree de 1' effort tangentiel a la 
trajectoire durant le mouvement. Dans la mesure ou les 
limites de vitesse et d' acceleration definies par « params » 

■ 

ne sont pas atteintes, le robot doit adapter son deplacement 
25 le long de la trajectoire de maniere a maintenir la valeur de 
1' effort tangentiel la plus proche possible de la- valeur 
specif iee par .le parametre « force ». 
L' instruction : 

MOVELF (position, outil, * params, force) 
30 est similaire. La seule difference est que le mouvement doit 
s'executer en ligne droite. 

On peut imaginer facilement des instructions similaires, 
definissant des trajectoires circulaires, ou definies par des 
splines ou autres... 
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II est important pour 1' invention que ces instructions 
definissent, d'une part, la geometrie de la trajectoire que 
doit suivre le robot et, d' autre part, la valeur de 1' effort 
tangentiel que doit exercer le robot lors de son deplacement. 

L' inteirpreteur de programmes 200 est charge d' exe cuter 
les programmes elabores avec 1 ' environnement de 
developpement . Pour executer les instructions de mouvement, 
il verifie la validite des parametres specifies par 
I'utilisateur, puis transmet 1 ' instruction de mouvement 300 
au generateur de trajectoire 400.' Les instructions de 
mouvement 3 00 contiennent les informations issues des valeurs 
specif iees dans le programme, a savoir : 

310 Definition de la geometrie de la trajectoire : Un 
indicateur indique le type de trajectoire (articulaire ou 
ligne droite) . Si le type est « articulaire », les 
coordonnees articulaires qO du point de depart et ql du 
point d'arrivee sont donnees . Si le type est « ligne 
droite », les coordonnees cartesiennes xO du point de 
depart et xl du point d'arrivee sont donnees. 

- 320 consigne d' effort tangentiel : II s'agit de la valeur 
desiree des de la norme de 1' effort cartesien exerce par 
1 ' extremite du robot sur son environnement . 

- 33 0 Limite de vitesse : valeur limite vmax pour la horme de 
la Vitesse cartesienne de 1' extremite du robot. 

- 340 Limite d' acceleration : valeur limite amax pour la 
noirme de 1 ' acceleration cartesienne de 1' extremite du 
robot . 

Dans le mode de realisation decrit ici, les commandes de 
mouvement 500 sont constituees par les positions angulalres 
qdes des 6 moteurs . Elles sont mises a -jour par le generateur 
de trajectoire toutes les 4 millisecondes . Cbaciine des six 
consignes de position qdesl, qdes2 , / qdes6 , est transferee 
au systeme d' asservissement correspondant pour chaque moteur 
601, 602,... 606 comme represente a la figure 4. 
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Chaque moteur est equipe d'un capteur de position et de 
Vitesse. L' asservissement sur chaque moteur est de type 
proportionnel- integral -derive (PID) . -A la figure 5/ qdes,j 
est la consigne de position sur I'axe j, qmes.j est la 
5 position mesuree, Kp,j, Ki,j et Kd,j sont les gains 
respectifs du PID, Ides , j est la consigne de courant, Imes,j 
est le courant mesure, et p est la variable de Laplace. 

D'autres techniques d' asservissement en position peuvent 
aussi etre employee dans le cadre de la presente Invention . 

10 Par exemple, 1' asservissement peut etre realise par la 
technique dite de decouplage et linearisation. Dans ce cas, 
1 ' asservissement n' est plus realise axe par axe. Dans notre 
exemple, les consignes de mouvement 500 sont les positions 
angulaires desirees pour chaque moteur. On peut aussi 

15 utiliser la position et la vitesse desirees de 1 ' organe 
terminal, exprimees dans des coordonnees cartesiennes . Les 
consignes de mouvement peuveht encore etre des increments de 
position successifs, ou bien les vitesses desirees sur chaque 
moteur a chaque instant. Le point important pour 1' invention 

20 est que le generateur de trajectoire 40 0 calcule en temps 
reel la trajectoire que doit suivre le robot et qu'un systeme 
d' asservissement fait en sorte que le robot suive au mieux 

cette tra j ectoire . 

De nombreux moyens sont possibles pour estimer 1' effort 

25 exerce par le robot sur I'exterieur dans le cadre de la 
presente invention. Le plus simple consiste a placer un 
capteur d' efforts a I'extremite du robot, Dans ce cas, 
1' effort exterieur 8 00 est exprime dans des coordonnees 
cartesiennes. On peut aussi utiliser des capteurs d' efforts 

30 ou de couples place a differerits endroits sur. le robot. 

Dans le mode de realisation propose et repr^sehte a la 
figure 6, on presente \ane . solution qui permet d' estimer 
1' effort exterieur en utilisant* des variables de 
1 ' asservissement de position. 
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La methode utilises requiere une valeiar 701 represent ant 
le courant I circulant dans chaque moteur. Dans notre cas, 
celle-ci est egale a la mesure de courant Imes utilisee dans 
le systeine d' asservissement . 
5 I = Imes = [Imes.l Imes, 2 ... Imes, 6] 

On pourrait aussi bien utiliser la commande de courant, 

soit 

I = Ides = [Ides,l Ides, 2 ... Ides, 6] 

ou toute autre variable, mesuree ou calculee, represent ant 

10 les courants circulants dans les moteurs . 

Les moteurs utilises sont des moteurs brushless. Le 
models 7 02 le plus simple pour ce type de moteur consist e a 
considerer que le couple delivre Cm 703 est proportionnel au 
courant t ravers ant le moteur, soit : 

15 Cm = Kt . I 

Dans cette expression, I et Cm sont des vecteurs 
contenant les informations relatives a chaque axe et Kt est 
une matrice diagonale. Des modeles plus complexes pourraient 
etre utilises en 702. 

20 D' autre part, la methode utilisee requiere des signaux 

representant les mouvements du robot 711, par exemple les 
positions, vitesses, accelerations de chaque moteur 
represents respectivement par les vecteurs q, dq/dt et 
d^q/dt^. Dans notre cas, ces valeurs sont deduites des mesures 

25 capteurs utilisees par le systeme d' asservissement et leurs 
derivees . 

q = qmes 

dq/dt = d(qmes)/dt 

d^q/dt^ = d^ (qmes)/dt^ 
3 0 On pourrait tout aussi utiliser "les VVconsignes de 

positions et leur d^rivges : qdes, d (qdes)Vdt^l 'd^- (qdes) /dt^ 

A partir des ces informations/ et d'un imodele dynamique 
du bras 712 etabli, par exemple, avec ' ^lefs ^."equations de 
Newton-Euler, . on calcule un vecteur Cd representant les 
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couples qu' exercerait en theorie chaque moteur du robot, s'il 
n'exergait aucun effort sur I'exterieur 713. 

On en deduit, par difference* en 720, un vecteur Cext 800 
qui est une estimation des couples moteurs correspondant aux 
5 efforts exerces par le robot sur son environnement 800 : 

Cext • = Cm - Cd 

La figure 7 montre comment I'algorithme utilise par le 
generateur de trajectoire peut etre decompose en quatre 
parties : 

10 ' A partir de la consigns d'effort tangentiel 310, de 

1' effort exterieur 8 00 et de la geometrie de la courbe 32 0, 
on calcule en 410 une variable d'erreur scalaix-e 420. Les 
limitations de vitesse 330 et d' acceleration 340 sont 
projetees en 430 sur la courbe 320. A partir des limites de 

15 Vitesse et d' acceleration projetees 470 ainsi que de la 
variable, d' erreur 420, un regulateur 430 calcule le mouvement 
desire le long de la courbe 44 0. Les consignes de mouvement 
du robot 50 0 sont alors calculees en 450 a partir de la 
definition de la geometrie de la courbe 32 0 et du mouvement 

20 le long de la courbe 440. 

Chacune de ces quatre parties est decrite dans ce qui 

suit . 

A - Calcul de la. variable d'erreur (410-420) : ca.s 

2 5 d'un mouvement en ligue droi te • 

• he calcul de la variable d'erreur 420 est pr^sente ici 
dans le cas d'un mouvement en ligne droite . Les calculs qui 
suivent consistent & Calculer la projection sur la courbe 320 
de la difference entre la consigne d' effort 310 et 1' effort 

3 0 exterieur 800 • ... 

» • . 

Lors d'uxx mouvement en ligne droite, la position 

-• « . -■ ... 

cartesienne x du robot (vecteur) peut etre parametree de la 
maniere suivante : 

x .= xO + s : (xl-xO) 
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Ou xO est le position cartesienne de depart du mouvement^ xl 
est la position cartesienne d'arrivee, et s est un parametre , 
scalaire compris entre 0 et 1. On peut re-ecrire I'eCTuation 
precedente sous la forme 
5 x = f (s) (Eq. 1) 

En derivant cette equation, on a : 
V = d>:/dt = df/ds . ds/dt (Eq. 2) 

Dans cette expression df/ds est un vecteur- cartesien 
tangent a la courbe . Le vecteur cartesien 
10 u = (df/ds) / I I df/ds | | 

est unitaire et tangent a la courbe. 

Dans notre example, la consigne d' effort 3 00 est la 
norme de 1' effort tangent cartesien. Le vecteijx d' effort 
cartesien desire vaut done : 
15 Fdes = fdes . u (Eq. 3) 

L' effort exterieur 800 est doime par le vecteur des 
couples articulaires Cext . On peut transformer cette valeur 
en coordonnees cartesienne en utilisant la formule suivante : 
Fext = J'^ . Cext (Eq. 4) 

20 ou J'*^ est 1' inverse de la transposee de la matrice jacobienne 
du robot . 

La variable de commande choisie 420, notee eps, est la 
difference entre 1' effort tangent desire et 1' effort 
exterieur, pro j ete sur la tangent e a la trajectoire, soit : 

25 eps = u^ . (Fdes - Fext) 

Ce calcul reste valide quel que soit la fonction f 
utilisee (cercle, spline, ou autre...) , dans la mesure ou elle 
est dif f erentiable, ce qui signifie qu'on peut definir sa 
tangente en tout point- * - 

30 Ce calcul a ete conduit dans le cas particulier ou la 

consigne d'effort 300*^ est la norme d'un* vecteur*^ d' effort \ 
cartesien et 1' effort exterieur 800 est donne en -coordonnees 
articulaires. En utilisant les formules de changement de 

* < • 

■ 4 

coordonnees adequates, par exemple a la place des eq[uations 
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Eq. 3 et Eq. 4, on peut trait er les cas ou les ces 
information sent donnees dans n'importe quel systeme de 
coor donnees . 

B - Calcul de la variable d'erreur (410-420) : cas 

d'un mouvement articulaire 

Dans le cas d'un mouvement articulaire, la position 
articulaire q du robot peut etre parametree de la maniere 

suivant e : 

q = qO + s . (ql-qO) 
ou qO est la position articulaire de depart du mouvement, ql 
est la position articulaire d'arrivee, et s est un parametre 
scalaire compris entre 0 et 1. On peut re-ecrire 1' Equation 
precedent e sous la forme 

q = g(s) 

La position cartesienne correspondante est 
X = k(q(s)) 

ou k est le modele geom^trique direct du robot. 

Le mouvement articulaire peut done se traiter comme le 
mouvement cartesien, en choisissant la fonction f telle que : 

f(s) = k(q(s)) 

C - Projection des limites de vitesse et 
d' acceleration le long de la courbe (460) 

Dans notre exeraple, les limites de vitesse sont donnees 
en coordonnees cartesiennes . Autrement dit, on souhaite que 
la norme de la vitesse v du robot soit inferieure h. lone 
Vitesse donn§e vmax, et la norroe de 1' acceleration 
cartesienne dv/dt soit inf erieiire a une acceleration donnee 
amax . ... 
On def init les valeurs suivantes : _ . 

{ds/dt)„«„, = min ( vmax / |1 df/ds || ; c . sqrtCam^V 1| df/ds ||) (Eq. 5) 
(d's/dt*)^ = ( amax - || df/ds || . (ds/dt)^ ) / || d'f/ds' || (Eq. S) 

ou 



max 
2 



max 
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c est une constante telle que 0 < c < 1 
sqrtO denote la fonction racine carree 
Supposons qu'on ait : 

ds/dt I < (ds/dt) 
d^s/dt' I < (d^s/dt^)^ax 
Alors, d'apres 1' equation Eq. 2, on a : 

II V j| = II df/ds . ds/dt 11=11 df/^is II . 1 ds/dt I ^ II df/ds II . (ds/dt) 
Et done, d'apres Inequation Eq. 5, .on a : 

I I V I I s vmax 

10 D' autre part, en derivant 1' equation Eq. 2, on a 

a = df/ds . d^s/dt^ + d^f/ds^ . (ds/dt) ^ 

done 

II a II = II df/ds , d^s/dt^ + d^f/ds^ . (ds/dt)2 II 

£ I I df/ds I I ■ I d^s/dt^ I + I I d^f /ds^ I I . I ds/dt I 
15 £ II df/ds 11- (d^s/dt^)„^ I + II d^f/cLs^ ||. (ds/dt) 

En utilisant les definitions des equations Eq. 5 et 

Eq. 6, on obtient : 
I I a 1 1 < amax 

Les valeurs (ds/dt) niax et (d^s/dt^) niax definissent done des 
2 0 contraintes sur les derivees de s, qui font en sorte que les 
limites de vitesse et d' acceleration .cartesiennes sont 
verifiees. On peut done considerer que ce sont les 
projections des. limites de vitesse et d' acceleration 
cartesienne dans les eoordonnees de s . 
25 De maniere similaire, on pourrait avoir des limitations- 

de vitesse et/ou d' acceleration articulaire en utilisant la 
fonction h(s) = k"^(f (s)) a la place de la fonction .f dans les 
calculs precedents - 



2 

2 
max 



30 D - Regulateur (430) 

Le regulateur 43 0 a pour role de generer des mouvements 
le. long de la courbe 440, de maniere a maintenir la variable 
d'erreur la plus proche de zero 420. 
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Le regulateur utilise est de type integral. Un 
regulateur integral « classigue » peut s'exprimer sous la 
foirme suivante : 

d(sdes) /dt = K . eps 

sdes = / d(sdes)/dt . dt 
ou sdes est la position desiree du robot le long de la 
courbe, expritnee dans les unites du parametre s de 1' equation 
Eq. 1, et K une constante . Ceci est represente sur le schema- 
block suivant, ou p designe la variable de Laplace. 



eps 
(420) 











i ► 


K 


dfsdesVdt^ 


1 


— H 






P 













sdes 
(440) 



430 



10 



Ce schema est equivalent a : 



eps 

.(420) 




d^sdes)/df ^ 



1 


dfsdes^/dt 


1 




p 




P 












430 



sdes 
(440) 



15 



Pour integi-er les limitations de vitesse et 
d' acceleration, on modifie le schema de la maniere suivante. 



eps 
(420) 




sdes 
(440) 



(430) 



max 



Les blocs « calcul ( ds / dt ) max ' » et « calcul (d s/dt ) 
calculent les limites de vitesse et d' acceleration projetees, 
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•en fonction de sdes, selon les equation Eg. 5 at Eg. 6 (df/ds 
et d^f/ds^ sont evaluees pour s = sdes) . Le bloc satVel satiire 
la Vitesse z en entree en fonction de (ds/dt)niax. Autrement 



dit, on a 



r 

(ds/dt)niax si Z > (ds/dt)TOax 

d(sdes)/dt = ^ z si | z | < (ds/dt)inax 

- (ds/dt)niax si Z < - (ds/dt)niax 

De meme, satAccel sature 1 ' acceleration u en fonction de 

(d^s/dt^)max/ Soit : 

r 

max 



W = ^ 



(d^s/dt^)niax si u > (d^s/dt^) 
u si I u I £ (d^s/dt") 

- (d^s/dt^)^ax si u < - (d^s/dt^) 



max 



ma:x 



Dans tous les cas, ce schema assure que : 

I d{sdes-)Vdt* I < • (ds/dt)-„iax ' ....... . . . . 

ce qui garantit que la norme de la vitesse cartesienne 

desiree le long de la trajectoire est inferieure a vmax. 



LorsqTJie la vitesse maximale n'est pas atteinte, on a 
z = d (sdes) /dt 

done 

w = d^ (sdes) /dt^ 
alors, 

I d^ (sdes)/dt- | < (d^s/dt^)^ax 
ce qui garantit que la norme de 1 'acceleration cartesienne 
est inferieure a amax. 

Dans un cadre general , 1 ' algorithme presente assure que 
la limite de vitesse cartesienne est toujours respectee ^ et 
que la limite d' acceleration est respectee dans la mesure ou 
la vitesse cartesienne maximale n'est pas atteinte. Dans le 
cas de la ligne droite, lorsque la limite de vitesse est 
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atteinte, 1 ' acceleration est nulla, done la limite 
d' acceleration est respectee. 

E - Calcul (430) des consigxxes de mouvement (500) 
Dans notre cas, les consignes de mouvement 500 sont les 
coordonnees articulaires du robot qdes . A partir de la 
position desiree le long de la courbe sdes, on peut calculer 
la consigne de position cartesienne correspondante , grace a 
1' equation parametrique de la courbe Eq. 1. 
xdes = f(sdes) 

Ensuite, on trouve les coordonnees articulaires grace au 
inodele geometrique inverse du robot, note k^. 
qdes = k"^ (xdes) 

Si les consignes de mouvement etaient des vitesses, on 
pourrait utiliser les changements de coordonnees 
correspondant sur les vitesses (Equation Eq. 2 et inverse de 
la matrice jacobienne du robot) . 
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REVEND I CAT I ON S 

1. Precede de commande des deplacements d'une partie 
5 inobile d'un robot multi^.axes le long d'line trajectoire, 

caracterise en ce gu'il comprend des etapes consistant a : 

fournir a un generateur de tra j ectoire (40 0) des 
instructions de mouvement (3 00) incluant au moins des 
informations relatives a la geometrie de la trajectoire (3 20) 
10 et a des consignes d' effort (310) ; 

calculer un signal (800) dit d' effort exterieur 
representant au moins une coraposante de 1 ' effort (F) exerce 
par ladite partie mobile (O) sur son enviromiement ; 

fournir, a une frequence d' echantillonnage 
15 predeterminee, ledit signal d'effox't exterieur (800) audit 
generateur de trajectoire (400) ; 

- calculer, au moyen dudit genex-ateur de trajectoire 
(400) et a une frequence d' echantillonnage predeterminee, des 
consignes de mouvement (500) le long de ladite trajectoire 
2 0 (32 0) de fagon a minimiser 1 ' ecart entre la projection (Ft) de 
1' effort exterieur sur la tangente (T) a la trajectoire et la 
projection de la consigne sur ladite tangente et 

fournir lesdites consignes de mouvement (500) a un 
moyen d' asservissement (601-606) qui permet de mettre en 
25 mouvement au moins un axe dudit robot -(600) conformement 
auxdites consignes de mouvement' (500) . 

2. Precede selon la revendication 1, caracterise en ce 
que ledit signal d' effort exterieur (800) * est calcule a 
partir d'une information representant le courant circulant 

30 dans au moins un actionneur (601-606) dudit robot (6.00) , 

3- Precede selon I'une des revendi cat ions precedentes, 
caracterise en" ce qu'il comprend . ime etape consistant a 
utiliser un modele dynamique (712) dudit robot (600) lors du 
calcul dudit signal d' effort exterieur (BOO). 



wo 2005/062143 PCT/FR2004/003291 

20 

4. Procede selon I'lme des revendications prec^dentes , 
caracterise en ce qu'il comprend une §tape consistant ^ 
fournir audit generateur de -trajectoire (400) au raoins une 
valeur limite de vitesse (33 0) et/ou une valeur limite 
d' acceleration (340) pour prise en compte lors du calcul 
desdites consignes de mouveraent (500) , de telle sorte que 
lesdites consignes soient conforme a ladite ou auxdites 

valeurs limites . 

5. Dispositif de commande des deplacements d'lme partie 
mobile d'un robot multiaxes le long d'une trajectoire, 
caracterise en ce qu'il comprend : 

- un generateur de trajectoire (400) apte a calculer des 
consignes de mouvement (500) en fonction d' instructions de 
mouvements (3 00) incluant au moins des informations relatives 
a la geometrie de la trajectoire (320) et B. des consignes 

d' effort (310) et 

- un estimateur d' effort (700) apte a generer un signal 
d' effort ext^rieur (800) representant au moins une composante 
de 1' effort (F) exerce par ladite partie mobile (O) sur son 
environnement et a fournir ledit signal audit generateur de 
trajectoire, a une frequence d' echantillonnage predetermin6e , 
alors que ledit generateur de trajectoire est apte a calculer 
lesdites consignes de mouvement (500) le long de ladite 
trajectoire (320), a une frequence d' echantillonnage 
predeterminee, de fagon a minimiser I'ecart entre la 
projection (Ft) de 1' effort exterieur sur la tangente (T) a la 
trajectoire et la projection de la consigne d' effort sur 
ladite tangente, lesdites consignes de mouvement (500) etant 
fournies a un moyen d' asservissement (601-606) permettant de 
mettre en mouvement au moins tin axe dudit robot (600) . 

6. Dispositif. selon la revendication 5, caracterise en 
ce qu'il comprend xan moyen interpreteur de programme (200) 
apte ai executer des programmes qui comportent des 
instructions .de mouvement (300) permettant de specifier au 
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moins la geometrie de la trajectoire (320) et des consignes 
d' effort (310) . 
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